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Abstract 

A new method to stabilize a vehicle, which is autonomously 
guided on the road by an optical sensor, is presented. Since the 
dynamical behavior of a vehicle is nonlinear and contains mutual 
couplings in the state variables, the design especially of algo- 
rithms for transverse control is based on the universal valid prin- 
ciple of nonlinear decoupling and control. This method works 
independent from any operating point and thus a high degree 
of accuracy and free pole assignment for the overall system is 
provided. 

1 Introduction 

In the last years many efforts have been achieved in realizing 
and integrating automation components in motor vehicles. 
In this context the task is followed to support the driver 
by efficient kinds of control and safety systems [1]. In this 
way anti block systems, methods to prevent a vehicle from 
skidding on icy roads [2] as well as the application of col- 
lision avoidance strategies are described [3]. Besides a very 
important aspect to increase safety in traffic is to direct a 
vehicle equipped with an on-board system automatically on 
the road [4]. Here a method is described, where the geometry 
of the street is detected by an optical system mounted on the 
car. Based on the information coming from this sensor the 
control system provides adequate control signals to stabilize 
the vehicle on the right lane. As the street has to be followed 
exactly, a high quality control system for the vehicle is re- 
quired. In this paper a very efficient strategy of transverse 
control based on nonlinear formulations is presented. Fur- 
thermore a longitudinal controller to influence the velocity 
of the vehicle is described. 


2 Mathematical model of the vehicle 

As already mentioned, the task is followed to develop a con- 
trol system, which directs the vehicle automatically along 
the road under consideration of a nominal speed. The right 
edge of the street is traced by an optical sensor, e.g. a video 
camera. In this way the distance l tr between the point P on 
the optical axis and the point E on the edge of the road 
can be determined. By further consideration of distance l( a 
between point P and the center of gravity of the vehicle a 
proportion of the car’s direction of movement in dependence 
of the course of the road can be indicated. This structure 
is illustrated by Fig. 1, where especially in the lower sketch 
the kinematics of the vehicle including the optical sensor is 
shown. Please note that // 0 represents a constant parameter 
and, in contrast, l tr is a dynamic variable. 

To develop an efficient control system a mathematical 
model describing the dynamical behavior of the vehicle is 
a very important supposition. Besides the requirements of 
high accuracy this model, which consists of several differen- 
tial equations, should be of certain clearness. A single track 
model describing transverse and longitudinal dynamics, ne- 
glecting roll and pitch angles and comprising front and rear 
wheels to one fictitious wheel respectively is well suited [5]. 
It is transferred into state space description, which will be 
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output vectors u (t) and y(t) are introduced as follows: 



Inputs are front side force S v of the vehicle depending on the 
steering angle S v by 


and rear driving or braking force H , while output variables 
are the yaw angle 0 describing the orientation of the vehicle 
and the velocity v of the car. As shown in Fig. 2, impor- 
tant state variables are the yaw angle the yaw velocity rp\ 


Figure 1: Mode of operation of the sensor 


the starting point for the design of the path control system: 

r ^ 1 T(x) Xl 1 S h (x) 1 


Figure 2: Dynamical variables of the vehicle 


which consists its first derivation, the longitudinal velocity v 
and the sideslip angle 0. The vehicle is of mass m and of mo- 
ment of inertia 0, while c v , c^, l v and are further constant 
parameters. The variables 5/ l (x) and T(x), which consist of 
the rear side force and the air resistance respectively, depend 
on their turn on the state variables and can be computed by 


Aerodynamic resistance coefficient, atmospheric density and 
surface of the vehicle’s cross section are represented by the 
parameters c w , q l and A. To keep clearness of the model 
equations for the derivation of the control laws these vari- 
ables are not inserted explicitly. In this way also the front 
side force is stipulated as an input variable of the model. 

Furthermore the actual position coordinates X and Y of 
the center of gravity in the stationary system is evaluated 


The 4-dimensional state vector x(t), which consists of the 
dynamical variables, as well as the 2-dimensional input and 
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with respect to the differential equations 
X - v cos (tp- 0) 

(5) 

Y — v sin(ip — /?). 

However, the coordinates Xp and Yp of the point P on the 
optical axis, which is of distance ho to the center of gravity 
are determined by 


X P = X + h 0 cosip 

( 6 ) 

Y P — X + ho sin ip. 

Please note that equations (5) and (6) are only required for 
the simulation. As shown in section 3, however, they are not 
required to develop the control algorithms. 


3 Nonlinear Path Control 

3.1 Design of the control algorithms: 

The dynamical behavior of a vehicle is extremely nonlinear 
and consists of mutual couplings. Control laws, which are 
based on a linearized model, would have the disadvantage 
of dependence from an operating point. However, if the de- 
sign of the control laws is based on the universal method of 
nonlinear decoupling and control, all couplings and nonlin- 
earities are compensated in a direct way and the controlled 
vehicle will be impressed a linear behavior with free pole as- 
signment [6]. Based on state space description (1) the task 
is to find algorithms to control the vehicle’s yaw angle xp 
and the velocity v by influencing front side force S v and rear 
longitudinal force H. 

The elements Ci(x) and (^(x) of the matrix C(x), rep- 
resenting the coordinates of the car’s center of gravity, are 
related to a subsystem each [7]. For both subsystems first the 
differential orders, which determine the order of the output 
variables’ derivations connected in a direct way to an input 
variable, have to be found out respectively. To determine the 
value greater zero for the subsystem i the differential oper- 
ator N^Ci(x) with k = 0,1,2,..., which can be recurrently 
evaluated by 

KCi (x) = ^-'c.(x)]a (x) (7) 

under consideration of the initial value 

KC. (x) = c,(x), (8) 

is introduced. Hence the differential orders of the subsystems 
are evaluated by the following formulation: 

d, = min [j : [£ Nf'C; (x)] B(x) + 0 T 

~ (9) 

j = 1,2, ..., nj 

with 0 as the zero vector. With respect to state space de- 
scription (1) the differential operators JVjC*(x) as well as the 


p a rts A^C,(x)]B (x) are evaluated for subsystem i — 1 
to 


KCiU) = 

U) = [o o] 

N\c ,(x) = *3 

[| N\ C l( x)]B (X) = £ 0], 


( 10 ) 


( 11 ) 


Furthermore for subsystem i — 2 these parts yield 


N° A C 2 (x) = z 4 

|| «5a«]B to - [o ^]. (12) 

d 

As for subsystem i = 1 part [— N°f?i(x)]B (x) = 0 T but 

0 

part A^Ci(x)]b (x) ^ 0 T and for subsystem i = 2 al- 

ready part [— A^C^x)] B (x) ^ 0 T the differential orders d{ 
for both subsystems result in 


d x = 2 
d 2 = 1 . 


(13) 


These values for the differential orders signify the immedi- 
ate effect of the system inputs on the second derivation of 
the yaw angle and the first derivation of the car’s velocity. 
As the output variables consist of the yaw angle, which is of 
kinematic character, and the velocity representing a kinetic 
variable, one receives different values for the differential or- 
ders of each subsystem. 


For further consideration also the operators 

KCrU) = 

N\C 2 (x) = 


(14) 


have to be calculated. Thus the 2x1- and 2x2-matrices result 
in 


C*(x) 


K'C, (x) 
N d /C 2 (x) 


Sh h 



m 


2 

4 


(15) 


and 


D*(x) = 


<| «i-c, (i) 

j| JVf-’C. (si 



' lv 

0 

l(x) = 

0 

1 

J 

0 

m . 


(16) 

respectively. These matrices are basic requirements to derive 
the nonlinear control algorithms which satisfy the universal 
equation 


u(<) = D*(x)-‘{-C’(xH-A w(<)-M*(x)}, (17) 



where the control signals u(f) are generated in dependence 
from the state variables x(t) and the nominal values w (t). As 
the elements of w (/) correspond to the elements of y(/), the 
nominal values for yaw angle and velocity are determined by 
wi(t) and w 2 (t) respectively. By the 2x2-matrix A, composed 
only by elements on the main diagonal, the nominal values 
are amplified, while by the 2x1 -matrix M*(x) pole assignment 
for the overall systems is carried out. 

The existence of the inverse of D*(x) is a necessary and 
sufficient condition for the decoupling of the system of dif- 
ferential equations ( 1 ). With respect to ( 16 ) the determinant 
of D*(x) results in 



whereby the inverse is calculated to 

ITU )' 1 = 


0 


0 

T v 

0 m 


( 19 ) 


To complete the control laws the matrices A and M*(x) have 
to be specified explicitly. By 


A = 


diag{A l5 A 2 } 


A, 0 
0 A2 


(20) 


the nominal values are weighted with respect to the amplifi- 
cations Ai and A 2 , while by 


N k A C,(x) 

k = 0 


c*oi x 2 + an ^3 

E «« MftU) 

. k=0 


ao2 x 4 


M*(x) = 


(21) 

the dynamical behavior of the decoupled subsystems can be 
adjusted by the constant parameters aoi, #02 and an. 


With respect to the universal formulation ( 17 ) and the 
corresponding matrices in ( 19 ), (20) and (21) the control 
laws are evaluated to 


Ui (t) = y 5 h(x) +r (Ai - “01 - «11 *3) 

l v l v 

u 2 (t) = T(x) -f -m (A 2 w 2 (t) — a 02 ^4) • 


( 22 ) 


As the control algorithms require the actual values for 5 /*(x) 
and T(x) of rear side force and air resistance, these variables 
are provided with respect to equations ( 4 ) in advance. 


3.2 Dynamical behavior of the overall system: 

With respect to the control algorithms ( 22 ) the dynamical 
behavior of the overall system is examined. Considering ( 1 ) 
and ( 13 ) these derivations yield 


V 1 = *3 
y 2 = £4. 


( 23 ) 


variables y\ and y 2 have to be derived respectively. Replac- 
ing the first derivations £3 and £4 by the corresponding right 
sides of (1) and by further substitution of the control vari- 
ables Ui(t) and u 2 (t) by the right sides of (22) the overall 
behavior of the controlled vehicle results in 


jii + <*n y\ + ot 01 yi - Ai wi(t) 
£2 + <*02 2/2 = A 2 tu 2 (i). 


( 24 ) 


By these equations the overall dynamics of the vehicle de- 
scribing in transverse direction a behavior of second order 
and describing in longitudinal direction a behavior of first 
order is determined. Desired variables are u>i(f) for the nom- 
inal yaw angle and w 2 (t) for the desired velocity of the car. 

With the free choosable parameters Ai , A 2 , aoi, «n and ao 2 
the dynamics of the controlled vehicle can be adjusted. It is 
sensible to introduce the following restrictions: 

a 0 i = Ai 

an = 2 yfc (25) 

a 0 2 = A 2 . 

In this way considering the stationary case the nominal val- 
ues and the corresponding output variables are weighted by 
the same parameters. Furthermore the aperiodic borderline 
case is adjusted in transverse direction. 

With the remaining degrees of freedom consisting of the 
parameters Ai and A 2 rapidity of control circuits can be in- 
fluenced by pole assignment. Here technical constraints of 
the vehicle have to be taken into consideration. 


3.3 Modification of the nonlinear control laws: 

As the value of the yaw angle, represented by variable x 2 
in (22), is not measured and also a nominal value wi(t) for 
the yaw angle does not exist explicitly, an adequate modifi- 
cation of the relevant control algorithm is necessary. Rather 
the task is followed to find a control system, which adjusts 
automatically the car’s direction of movement considering 
the course of the road. In this context the edge of the street 
is realized by the optical sensor mounted on the car. Ori- 
entations of the car and of the sensor are identical. So a 
control method must be found to adjust the yaw angle in de- 
pendence of the signal coming from the optical system. Due 
to these requirements in the control law for the yaw angle, 
which is represented by the first equation of (22), the vari- 
ables x 2 and Wi(t) have to be eliminated. In this way first 
the parameters Ai and a 0 i are equated to 

Ai = a 0 i, ( 26 ) 

so that the control error u>\(t) — x 2 can be factored out. The 
task is to substitute the control error in an adequate way. 
The deviation between the optical axis of the sensor and the 
edge of the street is determined by 

hr 

<t> = arctan — . ( 27 ) 

ho 


In this context d\ and d 2 indicate, how often the output 


As the control system has to direct the vehicle on the right 
lane with nominal distance w ltT to the right edge of the road, 
an offset 

w<t>(i) = arctan — tT ^ ( 28 ) 

ho 

has to be taken into account. By equation 

Wi(t)-x 2 = w<t>(t)-<t) (29) 

the control error is substituted by the difference w^t) - <p. 
1 his relation is illustrated by Fig. 3. If further the parame- 
ters A 2 and O 02 are equated the control laws (22) consider- 
ing (29) are transformed into 

ui(t) = — S h (x) (uty(t) — <t>) — cn u 0 * 3 ) 

lv v } (30) 

u i{t) = T(x) -f m (a 2 (mj 2 (/ ) — £4 )) • 

Herewith based on the present kinematic structure and the 
available sensors transverse and longitudinal dynamics are 
controlled. The desired values are represented by the nominal 
distance of the path of the vehicle to the right edge of the 
street and by the nominal velocity. 



Figure 3: Determination of the transverse control error 


3.4 Processing of original control signals: 

By equations (30) the required values of the control variables 
for front side force S v and rear driving or braking force H are 
computed. As the course of a vehicle is determined by the 
steering system, an algorithm is required to generate sub- 
sequently the corresponding value for the steering angle 8 V 
representing an original control signal in dependence of front 
side force S v . In contrast control signal H for driving or brak- 
ing force is correlated directly to the vehicle and thus it exists 
already as original control signal. For better distinction the 
original control signals Uj and u 2 are marked by a bar. 

Based on equation (3) and with respect to (2) the original 
control signal is generated in dependence of the value S v 
for front side force, which is represented by ui and evaluated 


by control law (30). In contrast the original control signal u 2 , 
which is identical to the desired value H for the rear driving 
or braking force, is represented by control variable u 2 : 


- _ x Ul , / *3 

Ml — O v — X\ + l v 

Cv X4 

u 2 — H = u 2 - 


(31) 


In this way the original control signals u (t) are generated 
in a tandem arranged unit in dependence of vector u(/) and 
state variables x and subsequently they are transferred to 
the actuators of the vehicle. 


3.5 Simulation results: 

To demonstrate the quality of the control system, the dynam- 
ical behavior of the controlled vehicle was examined by com- 
puter simulations. Vicarious in Fig. 4 the resulting manoevre 
based on a sudden 45°-bend of the right edge of the street, 
which represents a hard test for the control system, is shown. 
This bend can be recognized by the graph marked with ’E’, 
which consists of the fictitious path of the point E (see also 
Figs. 1 and 3). In contrast by the graph marked with ’P’ 
the in the same way fictitious path of the point P, which is 
located on the optical axis of the sensor system and which 
is here of distance U 0 — 5 m to the car’s center of gravity, is 
shown. It can be clearly recognized, how the vehicle, which 
drives a speed of 50 km/h, turns in this way that the con- 
trolled condition to keep the nominal distance of wi tr = 2 m 
between the points P and E is followed. With respect to (25) 
the path of the vehicle’s center of gravity drives through the 
bend with an aperiodic behavior and follows the street in 


Nonlinear Transverse Control 



x-coordinate [m] 


Figure 4: Dynamical behavior of the controlled vehicle 



an exact way. Furthermore the course of the original con- 
trol signal S v for the steering angle is described by the graph 
marked with T in dependence of the actual position of the 
car on the x-coordinate. 


4 Conclusion 

An on-board system for transverse and longitudinal control 
of an automatically guided vehicle based on nonlinear decou- 
pling strategies is presented. With respect to the transverse 
dynamics of the car the control signal for the steering system 
is generated in dependence of the information recorded by an 
optical sensor, which detects the edge of the road. In contrast 
the drive and the brakes are influenced by the longitudinal 
controller taking the nominal and the actual speed into con- 
sideration. Control signals for the steering system as well as 
for the drive and and the brakes of the vehicle are gener- 
ated by nonlinear algorithms. This method is especially dis- 
tinguished by its efficiency and its preknowledgement about 
the dynamical behavior of the overall system. Herewith an 
important requirement to increase safety in future traffic is 
realized. 
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